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(57) A motor controller controls the operation of an 
electric motor (28). The motor controller includes sen- 
sors (30, 97, 102) for sensing at least one dynamic 
operating characteristic of the motor and for providing a 
signal indicative of the at least one sensed dynamic 
motor operating characteristic. A variable gain regulator 
(1 90) receives a current command request signal hav- 
ing a value and provides a motor current control signal 
having a value functionally related to the value of the 
received current command request signal and a gain 
control value. A gain scheduler (196) is operatively cou- 



pled to the variable gain regulator (190) and to the sen- 
sor (30, 97, 1 02) for providing the gain control value to 
the variable gain regulator (196) in response to the 
sensed at least one dynamic motor operating character- 
istic to thereby control the amount of gain of the variable 
gain regulator (190). The motor controller further 
includes a drive circuit (204, 120) operatively connected 
to the variable gain regulator (1 90) and the motor (28) 
for energizing the motor in response to the motor cur- 
rent control signal. 
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Description 
Technical Field 

5 [0001] The present invention is directed to an electric assist steering system and is particularly directed an electric 
assist steering system having an improved motor current controller that provides a controllable bandwidth consistent to 
control objectives such as constant bandwidth substantially independent of motor operating conditions, reduced motor 
acoustic noise, increased torque output at speeds, and reduced torque ripple. 

*o P3pkgroun<J Qf the Invention 

[0002] Electric assist steering systems are well known in the art. Electric power assist steering systems that utilize a 
rack and pinion gear set provide power assist by using an electric motor to either (i) apply rotary force to a steering shaft 
connected to a pinion gear, or (ii) apply linear force to a steering member having the rack teeth thereon. The electric 
15 motor in such systems is typically controlled in response to (i) a driver's applied torque to the vehicle steering wheel, 
and (ii) sensed vehicle speed. 

[0003] U.S. Patent No. 4,415,054 to Drutchas (now U.S. Reissue Patent No. 32,222,), assigned to TRW Inc., utilizes 
a D.C. electric assist motor driven through an "H-bridge" arrangement. The assist motor includes a rotor encircling a 
steering member. The steering member has a first portion with a thread convolution and a second portion with straight 

20 cut rack teeth. Rotation of the electric assist motor rotor causes linear movement of the steering member through a ball- 
nut drivably connected to the thread convolution portion of the steering member. A torque sensing device is coupled to 
the steering wheel for sensing driver applied torque to the steering wheel. The torque sensing device uses a magnetic 
Hall-effect sensor that senses relative rotation between the input and output steering shafts across a torsion bar. An 
electronic control unit f ECU*) monitors the signal from the torque sensing device. A vehicle speed sensor provides a 

25 signal to the ECU indicative of the vehicle speed. The ECU controls current through the electric assist motor and, in 
turn, steering assist in response to both the sensed vehicle speed and the sensed applied steering torque. The ECU 
decreases steering assist as vehicle speed increases. This is commonly referred to in the art as speed proportional 
steering. 

[0004] U.S. Patent No. 5,257,828 to Miller et al., and assigned to TRW Inc., discloses an electric assist steering sys- 
30 tern having yaw rate control. This system uses a variable reluctance ("VR") motor to apply steering assist to the rack 
member. The torque demand signal is modified as a function of a steering rate feedback signal so as to provide damp- 
ing. 

[0005] U.S. Patent No. 5,504,403 to McLaughlin, and assigned to TRW Inc., discloses a method and apparatus for 
controlling an electric assist steering system using an adaptive blending torque filter. The adaptive blending torque filter 
35 processes the applied steering torque signal and maintains a selectable system bandwidth during system operation. 
This arrangement provides a steering system having a bandwidth that is substantially independent of vehicle speed and 
applied steering torque. 

[0006] Ideally, the electric motor of an electric assist steering system will have a bandwidth much greater than that of 
the electric steering system so that the response of the electric motor does not negatively impact the stability of the 

40 steering system. A variable reluctance motor is such a high bandwidth motor. A constant bandwidth motor is desirable 
so as to achieve control not only over the low frequency steering operation, but also over the higher frequency acoustic 
noise so that the motor is quiet. However, the uncontrolled bandwidth of a VR motor varies and is a function of the motor 
current i, the rotor position 6 relative to the stator, the motor resistance, and motor temperature t. It is desirable to main- 
tain a consistent system bandwidth independent of such motor operating conditions. The controller must compensate 

45 for this varying bandwidth to achieve a constant bandwidth. VR motors have acoustically sensitive structural modes in 
which the motor's stator housing ("shell") experience movement in a radial direction, and at particular drive frequencies, 
the motor shell will resonate. Unfortunately, this resonance can occur in the human audible range. The motor will, in 
effect, act as a "speaker" producing an undesirable motor buzz. The motor can further exhibit a "microphone" effect as 
a result of shell acceleration resulting in current oscillations in the motor coils inducing further noise out of the motor. It 

so is, therefore, desirable to reduce such acoustic noise and, in turn, torque ripple. 

Summary. Pf the invention 

[0007] In accordance with the present invention, a motor controller is provided having a variable gain. The gain is con- 
55 trolled as a function of the motor's rotor position and motor current. The gain is controlled so as to provide a consistent 
current bandwidth substantially independent of rotor position and motor current A filter is provided in a control loop to 
filter from a current command signal frequencies that could result in motor shell resonance. The system, in accordance 
with the present invention provides (i) consistent operating bandwidth, (ii) reduced acoustic noise, (iii) a fast-response 



2 



3NSDOCID: <EP 094352BA2_I_> 



EP0 943 528 A2 



time, (iv) reduced torque ripple, and (v) increased torque output at speeds. 

[0008] In accordance with one aspect of the present invention, a motor controller is provided for controlling the oper- 
ation of an electric motor. The motor controller comprises sensing means for sensing at least one dynamic operating 
characteristic of the motor and for providing a signal indicative of the at least one sensed dynamic motor operating char- 

5 acteristic. A variable gain regulator receives a current command request signal having a value and provides a motor 
current control signal having a value functionally related to the value of the received current command request signal 
and a gain control value. A gain scheduler is operatively coupled to the variable gain regulator and to the sensing 
means for providing the gain control value to the variable gain regulator in response to the sensed at least one dynamic 
motor operating characteristic to thereby control the amount of gain of the variable gain regulator. The motor controller 

10 further includes a drive circuit operatively connected to the variable gain regulator and the motor for energizing the 
motor in response to the motor current control signal. 

[0009] In accordance with another aspect of the present invention, an electric assist steering system is provided com- 
prising, a torque sensor for sensing applied steering torque and providing a signal having a value indicative of the 
applied steering torque. An electric assist motor is driving connected to a steering member so that when the electric 

is assist motor is energized, it provides steering assist. The system further includes a motor controller for providing a cur- 
rent command signal having a value functionally related to the sensed applied steering torque, and sensor means for 
sensing at least one dynamic operating characteristic of the motor and for providing a signal indicative of the at least 
one sensed dynamic motor operating characteristic. A variable gain regulator receives the current command request 
signal having a value and provides a motor current control signal having a value functionally related to the value of the 

20 received current command request signal and a gain control value. The system further includes a gain scheduler oper- 
atively coupled to the variable gain regulator and to the sensing means for providing the gain control value to the vari- 
able gain regulator in response to the sensed at least one dynamic motor operating characteristic to thereby control the 
amount of gain of the variable gain regulator. A drive circuit is operatively connected to the variable gain regulator and 
the motor for energizing the motor in response to the motor current control signal. 

25 [001 0] In accordance with yet another aspect of the present invention, a method is provided for controlling the oper- 
ation of an electric motor, said method comprising the steps of sensing at least one dynamic operating characteristic of 
the motor and providing a signal indicative of the at least one sensed dynamic motor operating characteristic, and pro- 
viding a variable gain regulator for receiving a current command request signal having a value and for providing a motor 
current control signal having a value functionally related to the value of the received current command request signal 

30 and a gain control value. The method further includes the steps of providing the gain control value to the variable gain 
regulator in response to the sensed at least one dynamic motor operating characteristic to thereby control the amount 
of gain of the variable gain regulator, and energizing the motor in response to the motor current control signal. 

Prfef Description pf the Prgwings 

35 

[001 1 ] Other features and advantages of the present invention will become apparent to those skilled in the art to which 
the present invention relates from a reading of the following detailed description with reference to the accompanying 
drawings, in which: 

40 Fig. 1 is a schematic block diagram illustrating a power assist steering system in accordance with the present inven- 
tion; 

Fig. 2 is a schematic block diagram of a portion of the system of Fig. 1 showing the adaptive blending torque filter 
in greater detail; 

Fig. 3 is a schematic block diagram of a portion of the system of Fig. 1 showing the digital motor current controller 
45 in greater detail; 

Fig. 4 is a schematic circuit diagram of a portion of the drive circuit and power switches shown in Fig. 1 ; 
Fig. 5 is block diagram showing a portion of the closed loop control function of the present invention; 
Fig. 6 is a three dimensional graphical representation of an inductance map of a VR motor; 
Fig. 7 is a three dimensional graphical representation of a proportional gain map as a function of sensed current 
so and rotor angle. 

Fig. 8 is a Bode plot of an open loop transfer function of a steering system at different current values with a motor 
offset at 0°; 

Fig. 9 is an illustration of a frequency response of motor shell acceleration to motor current command for the open 
loop system of Fig. 8; 

55 Fig. 1 0 is a Bode plot of an open loop transfer function of a steering system at different current values with a motor 
offset at 30°; 

Fig. 1 1 is an illustration of a frequency response of motor shell acceleration to motor current command for the open 
loop system of Fig. 10; 
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Fig. 12 is a Bode plot of a closed loop transfer function of a steering system not having the gain scheduler of the 
present invention at different current values with a motor offset at 0°; 

Fig. 13 is an illustration of a frequency response of motor shell acceleration to motor current command for the 
closed loop system of Fig. 12; 

5 Fig. 14 is a Bode plot of a closed loop transfer function of a steering system having the gain scheduler of the 

present invention at different current values with a motor offset at 0°; 

Fig. 15 is an illustration of a frequency response motor shell acceleration to motor current command for of the 
closed loop system of Fig. 14; 

Fig. 16 is a gain plot of a Bode plot of a typical notch filter; 
io Fig. 1 7 is a phase plot of the Bode plot for the notch filter of Fig. 1 6; 

Fig. 18 is a root locus plot of a notch f ilter in a complete current control system; 

Fig. 19 is a graphical illustration of a gain comparison of the notch consistent bandwidth controller of the present 
invention; 

Fig. 20 is a graphical illustration of a phase comparison of the notch consistent bandwidth controller of the present 
is invention; and 

Fig. 21 is a graphical illustration of motor shell acceleration with and without the notch consistent bandwidth con- 
troller of the present invention. 

Description of Preferred Embodiment 

20 

[0012] Referring to Fig. 1 , a power assist steering system 10 includes a steering wheel 12 operatively connected to 
a pinion gear 14. Specifically, the vehicle steering wheel 12 is connected to an input shaft 16 and the pinion gear 14 is 
connected to an output shaft 18. The input shaft 16 is operatively coupled to the output shaft 18 through a torsion bar 
20. 

25 [0013] The torsion bar 20 twists in response to applied steering torque thereby permitting relative rotation between 
the input shaft 1 6 and the output shaft 1 8. Stops, not shown, limit the amount of such relative rotation between the input 
and output shafts in a manner known in the art. The torsion bar 20 has a spring constant referred to herein as K t . In 
accordance with a preferred embodiment, the spring constant K t = 20 in-lb/deg. The amount of relative rotation between 
the input shaft 16 and the output shaft 18 in response to applied steering torque is functionally related to the spring con- 

30 staht of the torsion bar. 

[0014] As is well known in the art, the pinion gear 1 4 has helical teeth, not shown, which are meshingly engaged with 
straight cut teeth, not shown, on a rack or linear steering member 22. The pinion gear 1 4 in combination with the straight 
cut gear teeth on the rack member 22 form a rack and pinion gear set. The rack is steerably coupled to the vehicle's 
steerable wheels 24, 26 with steering linkage in a known manner. When the steering wheel 12 is turned, the rack and 

35 pinion gear set converts the rotary motion of the steering wheel 12 into linear motion of the rack 22. When the rack 
moves linearly, the steerable wheels 24, 26 pivot about their associated steering axes and the vehicle is steered. 
[0015] An electric assist motor 28 is drivingly connected to the rack 22 through a ball-nut, drive arrangement. When 
the electric motor 28 is energized, it provides power assist steering by aiding in the linear drive of the rack so as to aid 
in the rotation of the vehicle steering wheel 12 by the vehicle operator. 

40 [001 6] In accordance with a preferred embodiment of the present invention, the electric assist motor 28 is a variable 
reluctance ("VR") motor. A VR motor is desirable for use in an electric assist steering system because of its small size, 
low friction, and its high torque-to-inertia ratio. The VR motor 28, in accordance with a preferred embodiment of the 
present invention, is a four phase motor having eight stator poles and six rotor poles. The stator poles are arranged so 
as to be energized in pairs thereby forming the four phases of the motor. 

45 [001 7] The principles of operation of a VR motor are well known in the art and, therefore, are not described herein in 
detail. Basically, the stator poles are energized in pairs. The rotor moves so as to minimize the magnetic reluctance 
between the energized stator poles and the closest pair of rotor poles. Minimum reluctance occurs when a pair of rotor 
poles is aligned with the energized stator poles. Once minimum reluctance is achieved, i.e., when the rotor poles align 
with the energized stator poles, those energized stator coils are de-energized and, assuming further motor movement 

so is desired, an adjacent pair of stator coils (depending on the desired motor direction) are energized. 

[0018] In many DC motors; controlling the direction of current flow through the motor windings controls direction of 
motor rotation. In a VR motor, current is passed through the stator coils in only one direction independent of the desired 
direction of motor operation. The direction of motor rotation is controlled by the sequence in which the stator coils are 
energized. For example, for the motor to move in one direction, phase Aa is energized followed by Bb. If it is desirable 

55 to move the motor in the opposite direction, the energization of phase Aa would be followed by the energization of 
phase Dd. 

[0019] Controlling the current through the stator coils controls the torque produced by the motor. When the assist 
steering motor is energized, the rotor turns which, in turn, rotates the nut portion of the ball-nut drive arrangement. 
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When the nut rotates, the balls transfer a linear force to the rack. The direction of rack movement and, in turn, th s: direc- 
tion of steering movement of the steerable vehicle wheels, is dependent upon the direction of rotation of the mo or. 
[0020] A motor rotor position sensor 30 is operatively connected to the motor rotor and to the motor housing. The 
function of the rotor position sensor 30 is to provide an electric signal indicative of the position of the motor rotor relative 
5 to the motor stator. As is well known in the art, operation of a VR motor requires this position information. While any 
known rotor position sensor may be used with the present invention, a rotor position sensor of the type disclosed in U.S. 
Patent No. 5,625,239 to Persson et al., and assigned to TRW Inc., is preferred. 

[0021 ] A steering shaft position sensor 40 is operatively connected across the steering input shaft 1 6 and the steering 
output shaft 18 and provides an electric signal having a value indicative of the relative rotational position or relative 

10 angular orientation between the input shaft 1 6 and the output shaft 18. The position sensor 40 in combination with the 
torsion bar 20 form a torque sensor 44 that provides and electric signal having a value indicative of the applied steering 
torque. The steering wheel 12 is rotated by the driver during a steering maneuver through an angle e HW . The relative 
angle between the input shaft 16 and the output shaft 18 as a result of applied input torque is referred to herein as 6 P 
Taking the spring constant K t of the torsion bar 20 into account, the electric signal from the sensor 40 is also indicative 

is of the applied steering torque referred to herein as x 8 . 

[0022] The output of the torque sensor 44 is connected to a torque signal processing circuit 50. The processing circuit 
50 monitors the applied steering torque angle 8 p and, "knowing" the spring constant K t of the torsion bar 20, provides 
an electric signal indicative of the applied steering torque t 8 . 

[0023] The torque sensor signal is passed through a filtering circuit 52. Preferably, the filter 52 is an adaptive blending 
20 torque filter of the type disclosed in U.S. Patent No. 5,504,403 to McLaughlin, and assigned to TRW Inc. The adaptive 
blending torque filter 52 receives a vehicle speed signal from a vehicle speed sensor 56. The adaptive blending torque 
filter 52 is adapted to have a non-linear characteristic at torque frequencies less than a blending frequency and a linear 
characteristic at torque frequencies greater than the blending frequency. The blending filter 52 establishes the blending 
frequency at a value functionally related to the vehicle speed. It is contemplated that other torque signal filter arrange- 
25 ments may be used with the present invention. The purpose of the adaptive blending torque filter is to maintain a 
selectable system bandwidth during system operation and thereby, prevent steering sluggishness as vehicle speed 
increases. 

[0024] Referring to Fig. 2, the blending filter 52 includes both a low pass filter 70 and a high pass filter 71 , both con- 
nected to the output of the torque signal processor 50. The filters 70, 71 are designed such that summation of the two 

30 filters is identically one for all frequencies. The low pass filter 70 allows all of the signal x s with frequency x s! content 
below a predetermined blending frequency w b to pass through while rejecting all high frequency data. The high pass 
filter 71 allows all of the signal with frequency x^ content above some blending frequency w b to pass through while 
rejecting all low frequency data. The value of the blending filter frequency w b is a function of vehicle speed and is deter- 
mined by the blending filter determination circuit 68 connected to the output of the speed sensor 56. The determination 

35 of w b may be accomplished using a look-up table in a microcomputer having predetermine stored values or by calcula- 
tion in accordance with a desired control function. 

[0025] The low pass torque sensor output is connected to an assist curve circuit 69, which is preferably a look-up 
table. The vehicle speed sensor 56 is also operatively connected to the assist curve circuit. As is well known in the art, 
the amount of power assist desired for a vehicle steering system decreases as vehicle speed increases. Therefore, to 

40 maintain a proper or desirable feel for steering maneuvers, it is desirable to decrease the amount of steering power 
assist as the vehicle speed increases. This is referred to in the art as speed proportional steering. 
[0026] The assist torque x assist values are determined from stored values in a look-up table representing a plurality of 
assist curves of torque-in values verses torque-out values. Since torque assist varies as a function of vehicle speed, 
these curves range from values required during dry surface parking to those needed at high vehicle speeds. Generally, 

45 the value of the output from the assist curve circuit 69 is referred to as x^^. The actual values for control are deter- 
mined from interpolation of the predetermined values stored in the look-up table if needed. Preferably, dual assist 
curves with interpolation are used as described in U.S. Patent No. 5,568,389 to McLaughlin et al. and assigned to TRW 
Inc. 

[0027] The high passed torque sensor signal x^ from a high pass filter is multiplied 72 by a predetermined gain value 
so S c1 that is a function of the vehicle speed. The determination of S c1 may be accomplished using a look-up table in a 
microcomputer or may be accomplished using an actual calculation in accordance with a desired control function. Mod- 
ification of the high frequency assist gain value S c1 allows the bandwidth of the steering system to be modified. 
[0028] The assist curve value x assjst output from 69 and the determined high frequency assist gain value from 72 are 
summed in a summing function 79. This summed value output of the summing circuit 79 is referred to as x ba and is con- 
55 nected to an adaptive torque filter circuit 80. 

[0029] the adaptive torque filter circuit 80 filters the input blended assist torque signal x ba . The filter is adaptive in that 
its poles and zeros are allowed to change as the vehicle speed changes so as to provide an optimal control system. 
This filtering and results in a filtered torque signal x m is referred to herein as the torque demand signal. The torque 
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demand signal x m is connected to a motor controller 90. 

[0030] The blending filter determination circuit 68 and adaptive filter 80 are fully described in the above mentioned 
McLaughlin '403 patent; Basically, a linearized closed loop control system is considered for the design of the blending 
filter and adaptive filter for the steering system 10. Rotation of the hand wheel 1 2 results in an angular displacement of 

s 6h W on the steering wheel side of the torsion bar position sensor 40. This angular displacement is differenced with the 
resultant angular displacement of the output shaft 18 after it is driven in rotation by the electric assist motor by an angle 
e m through the gearing ratio represented by r^p where r m is the effective radius of the motor ball nut and r p is the effec- 
tive radius of the pinion. One radian of rotation of the ball nut produces r m inches of travel of the rack Similarly, one 
radian of rotation of the pinion produces r p inches of travel of the rack The resultant angular displacement 9 p times the 

10 spring constant K t gives the torque signal Xg. In the closed loop arrangement, the output Xg is connected to the low 
pass/high pass filter circuits. 

[0031] The torque signal is passed through the low pass filter 70 resulting in the low passed assist torque x s! . The 
high passed assist torque x 8h is determined by subtracting the low frequency assist torque from the torque signal x^ 
The reason that x sh can be determined in this way is discussed below. 
is [0032] Continuous domain blending filters are chosen such that the sum of the low pass filter G|(S) and the high pass 
filter G H (S) is always equal to one. The low pass filter is chosen to be a first order filter with a pole at g^. The high pass 
filter is defined by the constraint that the sum of the two filters must be one. Therefore, the low and high pass filters can 



When realizing a set of blending filters in a digital computer, those skilled in the art will appreciate that it is not necessary 
to construct separate high and low pass filter stages. Rather, the input to the blending filters ^ is passed through the 
low pass filter resulting In the signal x^. The high passed signal is the original input torque minus the low passed portion. 
30 This can be thought of equivalency as determining the low frequency portion of the signal and simply subtracting it out 
of the original signal. The result is a signal with only high frequency information. Alternatively, one can use higher order 
blending filters. However, the complexity of the filter computations increases with filter order in a digital computer. The 
use of first order filters is preferred. 

[0033] Referring back to Fig. 1, the output x m of the adaptive blending torque filter 52 is connected to a motor control- 
35 ler 90. The rotor position sensor 30 is connected to the motor controller 90 as is the vehicle speed sensor 56. The motor 
controller 90, which controls the assist motor 28, also controls steering damping in response to sensed rotor speed. 
Although motor damping may be controlled in any desired manner (if at all), a preferred damping arrangement is 
described in U.S. Patent No. 5,257,828 to Miller et al, and assigned to TRW Inc. 

[0034] A control system temperature sensor 98, and other inputs 94 are also connected to the motor controller 90. 
40 Such other inputs 94 may include any desired sensor such as yaw rate sensor, acceleration sensor, engine RPM sen- 
sor, etc. Such other inputs would be connected to the motor controller so as to provide motor control in responsive to 
such other sensed parameters. 

[0035] It is contemplated that the control circuitry making up the adaptive blending torque filter 52, motor controller 
90, and other circuitry described below, would be manufactured in an application specific integrated circuit ("ASIC"). 
45 The temperature sensor 98 would monitor the temperature of the ASIC. The control unit temperature sensor 98 pro- 
vides a signal to the controller 90 indicative of the temperature of the overall system control circuitry. The controller 90 
would adapt control of the motor in response to the sensed temperature. For example, a too high of temperature of the 
ASIC could warrant reducing the amount of assist provided. 

[0036] The motor controller 90 provides a motor current demand signal ic^ and a phase select signal $ S el in 
so response to the torque demand signal x m , the present rotor position 8 as sensed by the rotor position sensor 30, the 
direction of the torque demand, the sensed vehicle speed as sensed by the speed sensor 56, the sensed motor current 
as sensed by the motor current sensor 97, and the temperature of the control system as sensed by the temperature 
sensor 98. The controller 90 may include other desired control features such as system soft start, etc. These features 
are known in the art and are, therefore, not described herein. 
55 [0037] The motor controller SO provides the current demand signal in accordance with any known steering control 
algorithm. The current command values as functions of measured parameters are preferably stored in a look-up table 
in which values are selected in accordance with the measured parameters. Since a look-up table can only store a dis- 
crete number of values, final current command values would be determined using an interpolation technique. Such 
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interpolation is disclosed in U.S. Patent No. 5,475,289 to McLaughlin et al. and assigned to TRW Inc. The desired 
amount of steering assist as a function of applied steering torque, vehicle speed, etc., (i.e., the current command values 
in the look-up table) may be specified by the vehicle manufacturer. Such values may also be selected in response to 
computer modeling or through empirical methods. 
5 [0038] The controller 90 outputs the current command signal i C md<j> and the phase select signal $ se | to a digital motor 
current controller 100 ("DMCC"). Since the motor 28 is a four-phase VR motor (in accordance with a preferred embod- 
iment) the phase to be energized is selected in response to the motor position and the direction of the applied steering 
torque. 

[0039] A motor temperature sensor 102 is operative coupled to the motor 28 and provides the DMCC 100 a signal 
w indicative of the temperature of the motor 28. The output from the rotor position sensor 30 is also connected to the 
DMCC 100 as is the output of the motor current sensor 97. 

[0040] The output of the DMCC 100 controls the current provided to each motor phase through a drive circuit 120 
which is controllably connected to a plurality of power switches 110. The power switches 110 are operatively connected 
between the vehicle battery B+ and the stator coils of the motor 28. As mentioned above, control of a variable reluc- 
ts tance motor requires that the relative position between the rotor and the stator be known. 

[0041 ] Referring to Fig. 4, a portion of the drive circuit 1 20 and a portion of the power switches 1 1 0 are shown for the 
stator coils Aa and Cc, i.e., for two of the four phases of the preferred four phase motor. As mentioned, the eight stator 
poles make up the four motor phase windings designated Aa, Bb, Cc, and Dd. Sf the motor is moving continuously in 
one direction and assuming motor rotor position identifies phase Aa is the first phase to be energized, the energization 

20 of the phases would be Aa, AaBb, Bb, BbCc, Cc, CcDd, Dd, DdAa, Aa, etc. In the other direction, the energization of 
the phases would be Aa, AaDd, Dd, DdCc, Cc, CcBb. Bb, BbAa. Aa, etc. As should be appreciated, phases Aa and Cc 
will not be energized at the same time and phases Bb and Dd will not be energized at the same time. This fact permits 
a bit of savings in circuitry. Each of the phase windings Aa and Cc share an upper switching device to selectively con- 
nect one end of the windings to the positive battery terminal. Each of the motor windings Aa and Cc have their own 

25 switching device to selectively connect the other terminal of their associated winding to electrical ground. The windings 
Aa and Cc can share a current sense resistor since the two windings will not be energized at the same time. The switch- 
ing arrangement for the windings Bb and Dd are similar in that they share an upper switching device and a current 
sense resistor. A similar control arrangement can be applied to a three phase system, though each phase would require 
to own DMCC and no sharing of FETs nor current sense resistors. 

30 [0042] Specifically, Fig. 4 shows the connection for the drive circuitry and power switches for phases Aa and Cc. The 
other motor phases Bb, Dd have similar drive and switching circuits. A lower switching device 160 is operatively con- 
nected between one side of the stator coil Aa and electrical ground. A lower switching device 161 is operatively con- 
nected between one side of the stator coil Cc and electrical ground. An upper switching device 1 63 is operative coupled 
to the other side of the coil pair Aa and Cc through a current sense resistor 164. The other side of the switching device 

35 1 61 is connected to the vehicle battery through an LC filter network 1 65. A first fly-back diode 1 66 is connected between 
the lower terminal of the coil Aa and the LC filter 162. A second fly-back diode 167 is connected between ground and 
the switching device 163. A third fly-back diode 168 is connected between the lower terminal of the coil Cc and the LC 
filter 165. An over-voltage protection Zener diode 169 is connected across switching device 163. An over-voltage pro- 
tection Zener diode 1 70 is connected across switching device 1 60. An over-voltage protection Zener diode 1 71 is con- 

40 nected across switching device 161 . Preferably, switching devices 160, 161, and 163 are solid state switches such as 
field-effect-transistors ("FETs"). The motor current sensor 97 is operatively coupled across the current sense resistor 
164. Current control is accomplished by the digital motor current controller 100 controllably connected to each of the 
switches 160, 161 , 163. Motor current is controlled by pulse-width-modulating f PWM") the switches 160, 161 . and 163. 
[0043] Each of the upper FET 161 and bottom FETs 160, 161 are continuously PWM'ed. Current through the asso- 

45 dated motor coil is controlled by the amount of the ON time overlap of their associated PWM control signals. When no 
current is to be supplied to a particular phase of the motor, its associated upper and lower FETs, although both being 
continuously pulse width modulated, have a 0% ON time overlap. Maximum phase current for any of the windings (coils) 
would occur when there is a 1 00% ON time overlap the PWM ON times of its associated upper and lower FETs. By con- 
trolling the amount of the ON time overlap, current through each of the motor phases is controlled. 

so [0044] Referring to Fig. 3, the digital motor current controller ("DMCC") 100 is shown in greater detail. The DMCC 
controls current to all phases of the motor 28 by processing the current command signal i cmd(}) and the phase select sig- 
nal <|>sel frorn tne controller 90. The purpose of the digital motor current controller 100 is to maintain a consistent band- 
width that is independent of the motor operating parameters of rotor position, motor current, and motor temperature. As 
mentioned, in the preferred four phase motor (phases Aa, Bb, Cc, and Dd), phases Aa and Cc will not be energized at 

55 the same time and phases Bb and Dd will not be energized at the same time. This permits not only the circuitry savings 
in the drive circuit 120 and power switches 110 discussed above, but also in the amount of circuitry and software in the 
DMCC. For the purposes of explanation, one control arrangement within the DMCC is described, it being understood 
that this would represent the control arrangement for two phases, e.g., Aa and Cc, and that the DMCC will include sim- 



7 



BNSDOCID: <EP 0943528 A2_l_> 



EP0943528A2 

ilar circuitry/functions for other motor phases Bb and Dd. 

[0045] The current command i cmd(}) from the motor controller for a phase to be energized is connected to a first filter 
circuit 182. This filter 182 is preferably a pre-notch filter to remove any unwanted frequency content from the current 
command signal i C md<t>' Preferably, this fitter is a second order filter realized in either series form or in parallel form. The 
s filter 1 82 takes the following form: 

f cmd{n)= a * f 'cmd(n-1) +b * f 'cmd(n-Z) +c ' l ' unflltcmd{n) +d ^' unmtcmd{n^) +e ^ 1 unfincmd{n-2) 

In accordance with one embodiment, the filter is designed to notch out 2.4 kHz because the motors primary radial-axial 
io mode (i.e., the motor's resonate frequency) is at 2.4 kHz. This also corresponds to the frequency at which the motor 
best emits acoustic noise. The notch filter removes energy in the command path that may excite the acoustic noise pro- 
ducing mode of the motor shell. This value is, of course, dependent upon the particular motor used. 
[0046] The filtered current command signal is next processed in a DC gain compensator 1 84 that is designed to com- 
pensate, for any steady state gain loss in the control loop due to relative magnitude differences. As will be appreciated 
is from the discussion below, the DC gain compensator 184. under certain design criteria of the control loop, may be elim- 
inated from the control loop of the DMCC. For example, if a proportional controller is used, the DC gain compensator is 
needed. If an integral controller is used, the DC gain conpensator may be unnecessary. 

[0047] The DC gain compensator 1 84 provides a reference current command value i rcmd to a positive input of a feed- 
back summing junction 186. The negative input of the summing junction 186 is connected to a motor current sense i s 
20 feedback line. The output of the summing junction 1 86 is a current difference value Ai cmd which is equal to the value of 
the difference between the reference current command value and the sensed motor current value, i.e., 

Al 'cmd =i rcmd' i s 

25 This difference value Ai cmd is connected to a variable gain controller 1 90 (also referred to as a variable gain regulator). 
In accordance with one embodiment of the present invention, the variable gain controller is a proportional-integral- 
derivative ("PID") controller or regulator 190. PID controllers are known in the art. The PID controller 190, in accordance 
with the present invention, takes the following form: 
Let e(k)=Ai cmd (k) 

30 

ecmd (k)=(K p {k) . e(k)M^ e ^^ /c " 1 ^ H^/(ge(k)6Q 

35 where Kp, Kd, and K| are proportional, derivative, and integral gain variables, respectively, k is the sample value, 6t is 
the sample rate, and e cmd is the error command output of the PID controller 130. These gain variables and, in turn, the 
gain of the controller PID are controlled in accordance with the present invention. 

[0048] The rotor position sensor 30. the temperature sensor 1 02, and the feedback current sense i s from the motor 
current sense function 97 are connected to a gain scheduler 1 96. The gain scheduler 1 96 selects the values of the gain 
40 variables Kp, r^, and K| in response to rotor position, motor temperature, and sensed motor current and outputs these 
values to the PID regulator 190. The proportional gain term K p is connected to the DC gain compensator 184 so that 
gain compensation "knows" the control loop gain. 

[0049] The values for Kp, f^. and K| are selected to not only provide a consistent current bandwidth but also to reduce 
acoustic noise induced by the current oscillation and to provide a fast motor current response time. The consistent 
45 bandwidth allows application of linear time invariant control theory since the nonlinear phase change from parameter 
variation is adaptively eliminated. In effect, the adaptive controller 190 reduces the effect of motor operating parameter 
variations from the resultant motor torque. 

[0050] The error command output, e cmd , of the PID controller 190 is connected to a notch filter 200. The purpose of 
the notch filer 200 is to eliminate acoustic noise due io stator shell vibration. 

so [0051] It has been discovered that energization of a pair of the VR motor's poles results in radial movement of the 
stator's shell. This is referred to as the motor's acoustically sensitive structural mode. At certain drive frequencies, the 
stator shell can resonate at a frequency well within the human audible range. This resonance makes the motor act as 
a "speaker". The motor can also act as a microphone in that the resonance affect can result in current fluctuations in 
the energized phase. Ttie radial movement of the shell can be expressed in terms of shell displacement, velocity, and/or 

55 acceleration. 

[0052] The notch filter 200 notches out the resonant frequencies of the acoustically sensitive structural modes of the 
motor from the voltage applied to the motor coil. The output of the notch filter 200 is connected to a PWM formatter 204. 
The phase select signal <|>sel f ro™ the controller 90 is also connected to the PWM formatter 204. The output of the PWM 
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formatter 204 is controllably connected to the upper and lower switching FETs to control the PWM ON times for each 
of the motor phases. In response to the filtered current demand signal from the notch filter 200 and the phase select 
signal, the PWM format controls the ON time overlap of the appropriate upper and lower switching FETs to energize the 
motor in the desired direction with the desired torque. 
5 [0053] The motor controller 90 is operatively coupled to a diagnostic indicator 240 located within the passenger com- 
partment of the vehicle. As is known in the art, the controller 90 (or another controller not shown) monitors system oper- 
ation and actuates indicator 240 if a fault condition is sensed. When a fault condition is sensed, the motor 28 is 
prevented from being energized and the steering system reverts to an unassisted mode. 

[0054] It is desirable, particularly in an electric assist steering system, to have a control arrangement that has reduced 
10 torque ripple. To properly control the VR motor torque, magnetic flux has to be induced by the current controller at each 
motor phase. During control of the motor, a changing flux linkage occurs that is a function of the varying motor operating 
conditions. A typical flux linkage for a VR motor is a function of the motor operating conditions such as the current and 
position. The changing nature of the flux linkage results in a time-varying dynamics of the VR motor during operation. 
The varying characteristic is most significant during the phase transition when the reluctance, the air volume between 
15 the stator and rotor, varies from the maximum value to the minimum value. 

[0055] Torque ripple will occur if the phase transition is not controlled and compensated. To minimize the torque ripple, 
an optimized current prof fle that eliminates most of the torque ripple is generated. Even with such a current profile, the 
control arrangement must account for the time-varying dynamic motor characteristics. The time-varying phase current 
can be expressed as follows: 

20 

L dL v ri . iR /dM».9 t x) 6 ,dMi.e,x) A 
L dt cmd I de ° dx V 1 

25 where L(i.0,x) is phase inductance as a function of the current i, position 6, and air gap x, 
R is motor resistance, 

X(i,e,x): flux linkage as a function of current i, position e, and air gap x, 

30 

a-i is white noise, 

v cmd is the voltage command, 

35 9 is the rotational rate of the motor, and 

x is the radial displacement rate of the motor shell. 

[0056] The control of the phase current is limited by the battery voltage B+ as to how much voltage command V cmd 
40 can be applied. In addition, the last three terms of the above equation are treated as disturbance d 1p which would 
require disturbance rejection to maintain robustness. The current equation can be written as: 

45 

[0057] Notice that the inductance is a function of current, position, and air gap. Assuming the air gap effect is negligi- 
ble, the inductance of a VR motor can be expressed as a three dimensional map, as shown in Fig. 6. This map was 
empirically measured for a single phase of a four phase VR motor using an inductance analyzer. This varying induct- 
so ance characteristic of the motor will affect the current control performance, and, in accordance with the present inven- 
tion, is considered in the control arrangement. As the motor rotates, the inductance appears to be time-varying even 
though inductance is a deterministic function of current and angle. 

[0058] For a digital current control system with an anti-aiiasing filter with a pole at frequency "a" and a proportional 
gain K p , the transfer function can be approximated in the Laplace domain as follows: 

55 
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_jm Kp(S+3) 

5 

[0059] The magnitude of the inductance will change the pole locations of this transfer function and affect the perform- 
ance of the closed-loop current controller. With a fixed gain Kp, the pole locations would move from the real axis to the 
complex plane. With this changing pole location, the system can change from stable to oscillatory or even an unstable 
system if extra poles and zeros are introduced without acknowledging these varying motor characteristics during oper- 
io ation. If the fixed proportional gain value Kp is lowered so that the current response does not exhibit oscillation, motor 
acoustic noise is reduced but torque ripple will occur due to poor current control. This will also compromise the control- 
ler's performance by decreasing the tracking capability for both a transient and steady state response in certain condi- 
tions. 

[0060] The gain scheduler, in accordance with the present invention, can be tuned to any desirable bandwidth 
is depending on the design criteria. To smooth out the time-varying effect of the dynamic system, the design objective is 
to maintain a consistent system characteristics of constant bandwidth and consistent phase lag. 
[0061 ] Solving the characteristic equation, the dominant real pole of the system can be expressed as 



20 




[0062] In general, the following assumption can be made 

25 

R«aL 

for example 

30 R<0.1 £2«aL(i,6)<3. 14=5000 Hz • 2n • 100 jiH 

[0063] The equation can be simplified as 

S p-2N 1 -Tane) J 



[0064] To ensure a real pole, the following condition must be true 



[0065] And to maintain a constant bandwidth a> ref , the proportional gain of the system has to be scheduled as a func- 
45 tion of inductance, resistance, and anti-aliasing filter pole location and can be expressed as follows: 

k p =^[hi-%V]-r 

50 

[0066] The gain map as a function of the inductance using this equation can then be generated and is shown in Fig. 7. 
[0067] Without the anti-aliasing filter, the gain scheduler can be further simplified to: 

K p =L(i,e)-a> ref -R 

55 

[0068] The temperature will also affect the gain map by increasing the motor resistance with higher temperature. In 
this case, the temperature effect can be included as follows: 
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c 



K p .Stp[l.(,-^a) 2 ]-R.ARCD 



5 [0089] The last term is the resistance change due to the temperature effects. The motor temperature ir. t ensed by the 
motor temperature sensor 1 02. 

[0070] The steady state error can be significant when the scheduled gain Kp is lowered. The steady late error can 
be expressed as: 

i^Utoadystat* R+Kp 

[0071] For example, nominal gain for a typical control system is about 2 and the resistance is approximately 0.1 
is Ohms, which would introduce a 5% steady state error. However, as the gain scheduler is adaptively calculating Kp to 
compensate the inductance variation, the gain Kp can be small enough to induce a large steady state error. This is cor- 
rected by the DC gain compensator 1 84. The DC gain compensator can be expressed as the following: 

2 Q K DC_compensator = ^ + 

[0072] The shell vibration can be reduced using the consistent gain current controller. Maintaining the current control 
bandwidth at a lower level will reduce the shell acceleration using a constant gain controller. The gain scheduler was 
25 used in one embodiment of the present invention to maintain the current control bandwidth at approximately 330 Hz. 
[0073] The notch filter reduces noise gain from the feedback path of the current control loop. The noise transfer func- 
tion of d 2 can be expressed as 

J 1 

L(i.e)[s +( L(i e) )s+ Uj e) J 

[0074] The denominator is the same as the current response characteristic equation. The motor acoustic noise is 
35 directly related to the current control loop through motor housing or shell acceleration. Reducing the noise response at 
the structural mode is equivalent of restricting the gain of the current control loop at that frequency. Without the gain 
scheduler of the present invention, the bandwidth can approach the motor's structural mode which will provide high 
noise gain and induce more acoustic noise. The gain scheduler will reduce the excitation at that frequency by maintain- 
ing a consistent bandwidth which is lower than the highest varying bandwidth without the invention. 
40 [0075] The value of Kp is functionally related to the motor current, motor position, system resistance and motor tem- 
perature. Values for K p are preferably predetermined and stored in a look-up table. 

[0076] Referring to Fig. 5, the closed loop feed-back control arrangement for the digital motor current controller is 
shown. The output of the DC gain compensator 184, which is the reference current command signal i rC md. is connected 
to the summing circuit 186 as described above. The other input to the summing circuit is the motor current feed-back 

45 signal i s . The variable gain PID controller is represented by the transfer function designation G c . The transfer function 
for the notch filter 200 is represented by the transfer function designation G n . Voltage noise N v is present in the system 
and is shown as being summed into the control loop. The notch filter G n plus the voltage noise N v is connected to the 
motor coil having transfer function designation G m . The motor current i m is summed with current noise N s present in the 
system which results in a sensed feedback current i s . The sensed feedback current i s is summed with the reference 

so command current i rcmd through a closed loop switch. This switch is shown to designate a break point when considering 
the normally closed loop system as an open loop control system. 

[0077] Referring to Fig. 8, a Bode plot is shown for an open loop transfer function of phase D motor current i m to motor 
command i cmd (the switch in the feedback line is open) with the rotor offset by 0° at different currents. The angle 0° is 
the angle at which the rotor is aligned when phase-D of the motor is energized. This is generally termed the aligned 
55 rotor position and is a stable equilibrium point for the motor, i.e., when the coil is energized, the rotor will stay at 0°. The 
angle 30° is the a rotation of 30 mechanical degrees from the 0° point This location is an unstable equilibrium point for 
phase-D excitation because the rotor pole is exactly between two stator poles, and in order to maximize inductance, the 
rotor must rotate either to 0° or 60°. This graph is for a steering system without the digital motor controller of the present 
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invention. As the current increases, the high frequency gain increases. The line 300 is a current value less than the cur- 
rent represented by line 302 which is, in turn, less than the current value represented by line 304, which is, in turn, less 
than the current value represented by the line 306. 

[0078] The high frequency gain increases with current because the inductance of the motor decreases with current 
5 at the aligned rotor position. The pole of the motor is at the frequency R/L and the higher the pole, the higher the gain 
at high frequency. 

[0079] A plot of the motor shell acceleration is shown in Fig. 9 with the lines representing the same current valuer 
shown in Fig. 8, again, without the digital motor current controller of the present invention. This graph shows a resonant 
frequency for the motor shell at 2.4 kHz. 

10 [0080] Fig. 10 is a Bode plot with the lines representing the same current values shown in Fig. 8, again, without the 
digital motor current controller of the present invention. This graph is different in that it represents a rotor offset by 30° 
which is the maximum offset that would occur in a four phase motor with a rotor having six rotor poles. In this plot, one 
can see that the high frequency gains are the same when the motor inductance is at a minimum. The high frequency 
gain is substantially constant with increasing current because the inductance of the motor is substantially constant with 

is respect to current at the unaligned rotor position. 

[0081] Fig. 11 is a frequency response showing the shell acceleration when the motor rotor is at the 30° offset condi- 
tion, again, without the digital motor current controller of the present invention. One can see that the motor resonance 
again occurs at 2.4 kHz. 

[0082] Fig. 12 is a Bode plot of a closed loop control with constant gain controller when the motor rotor is offset at 0°. 
20 [0083] Fig. 1 3 is a frequency response plot showing the shell acceleration with the use of a constant gain controller. 
This graph shows the shell acceleration at the motor resonant frequency of 2.4 kHz. 

[0084] Fig. 1 4 is a Bode plot showing the closed loop control arrangement with the gain scheduler, in accordance with 
the present invention, with a rotor offset at 0° offset. This plot shows a significant improvement in the system frequency 
response and the 3 dB roll-off points, i.e., the bandwidth of the motor current control is more constant than for the con- 
25 stant gain system of Fig. 12. 

[0085] Fig. 15 is a frequency response plot showing the shell acceleration when the gain scheduler, in accordance 
with the present invention, is used at a rotor offset of 0°. One can see a substantial decrease in the shell acceleration 
which, in turn, equates into reduced audible noise and reduced torque ripple. 

[0086] Note that the effect of the gain scheduler (Fig. 1 3) is to obtain a more constant bandwidth of the current transfer 
30 function when compared to the constant gain system (Fig. 1 2). The gain is more constant in Fig. 1 3 because the chang- 
ing inductance of the coil as motor current increases is compensated by decreasing the proportional gain of the system. 
The effect of the gain scheduler is also to reduce the acceleration of the motor shell when compared with a constant 
gain system (Figs. 13 and 15). 

[0087] The notch filter 200 functions to shape the frequency response of the motor current controller within its control 
35 bandwidth. For example, shaping the frequency response of the motor current controller avoids the acoustic noise by 
notching out the resonant frequencies of the acoustically sensitive structural modes, i.e.. those frequencies at which the 
stator shell will resonate. By controlling the acoustic noise, the motor current control bandwidth can be increased. By 
increasing this control bandwidth, torque ripple is reduced. The notch filter avoids the structural resonance that pro- 
duces acoustic noise. 

40 [0088] Gc is the transfer function for the controller 1 90. Assuming that the controller 1 90 is a proportional/integral con- 
troller, its transfer function is: 



where co n1t 0^2 are the frequencies close to the notch and the ratio of the damping factors £1 and £2 define the depth 
of the notch. In the present embodiment, co n1 =© n2 =2100 • 2n, £1=0.1 and £2=0.6 providing about 15dB of rejection. 
(In this embodiment, motor resonance is at 2.1 KHz) 
55 The motor transfer function Q m is: 



G c =K p (1+K,/s) 



45 The transfer function G n for the notch filter 200 is: 




S 2 +2£ 2 a> n2 S+a>n 2 



50 



Gm= 



1 
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where L is the local inductance of the motor and R is the resistance. 
[0089] Considering the control loop transfer functions, one gets: 



The command response is then: 



The sensor noise response is: 



((W('m+N e ))<3 c G n +A/,,)G m =/, 



<m G c G n G m 



'rcmd 1+G c G n G r 



'm - G c G n G r, 



N s 1+G c G m G„ 



The voftage noise response is: 
20 i m G 



m 



N„~UG 0 G m G n 



[0090] Given a consistent current bandwidth motor, the notch G n can be used to design a motor current controller that 
25 attenuates the noise at the frequency where the structural noise occurs. As shown in Figs. 16 and 17, a notch G n was 
designed to provide 20 dB attenuation of the motor shell acceleration. From the root locus analysis, as shown in Fig. 
18, a closed loop current controller can be designed to achieve a notched consistent bandwidth that does not excite the 
motor structural noise. Compared to the lowest bandwidth of a constant gain controller, as shown in Figs. 19 and 20, 
the notched consistent bandwidth controller has lower noise magnifying gain while maintaining a higher bandwidth. The 
30 lower fall off trace is 100 Hz and the upper fall off trace is 600 Hz. 

[0091] The result of the above controller was tested at 20 rpm and the shell vibration was measured and compared 
to a constant gain controller. As shown in Fig. 21 , the power spectral density of the proposed notched consistent band- 
width is only 1 .4% of the constant gain controller. The upper plot in Fig. 21 is without the notch filter and the bottom plot 
is with the notch consistent bandwidth controller. 
35 [0092] Attached hereto as Appendix A is a copy of a software program listing for implementation of the digital motor 
current controller. The gain scheduler and notch filter could be implemented either digitally using a microcomputer to 
accomplish the functions depicted in the Figures, using discrete circuitry, or using a combination of digital and discrete 
implementation preferably housed in an ASIC. 

[0093] From the above description of preferred embodiments of the invention, those skilled in the art will perceive 
40 improvements, changes and modifications. For example, dynamic operating characteristics such as position, current, 
and temperature were used in the motor control. Those skilled in the art will appreciate that motor flux can be used in 
the motor control as a dynamic operating characteristic. Such improvements, changes and modifications within the skill 
of the art are intended to be covered by the appended claims. 

[0094] According to its broadest aspect the invention relates to a motor controller for controlling the operation of an 
45 electric motor, said motor controller comprising: sensing means for sensing at least one dynamic operating character- 
istic of said motor and for providing a signal indicative of the at least one sensed dynamic motor operating characteris- 
tic; and variable gain regulator for receiving a current command request signal having a value and for providing a motor 
current control signal. 

so SUMMARY OF THE INVENTION 



55 



[0095] 

1 . A motor controller for controlling the operation of an electric motor, said motor controller comprising: 

sensing means for sensing at least one dynamic operating characteristic of said motor and for providing a sig- 
nal indicative of the at least one sensed dynamic motor operating characteristic; 
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variable gain regulator for receiving a current command request signal having a value and for providing a motor 
current control signal having a value functionally related to the value of said received current command request 
signal and a gain control value; 

s gain scheduler operatively coupled to said variable gain regulator and to said sensing means for providing said 

gain control value to said variable gain regulator in response to said sensed at least one dynamic motor oper- 
ating characteristic to thereby control the amount of gain of said variable gain regulator; and 

drive circuit operatively connected to the variable gain regulator and said motor for energizing said motor in 
10 response to said motor current control signal. 

2. The motor controller wherein said motor is a variable reluctance motor having a stator and a rotor and wherein 
said dynamic operating characteristic is position and wherein said sensor means includes a rotor position sensor 
that provides a signal having a value indicative of the position of the motor's rotor relative to its stator. 
15 3. The motor controller wherein said motor is a variable reluctance motor and wherein said dynamic operating char- 
acteristic is current and wherein said sensor means includes a motor current sensor that provides a signal having 
a value indicative of the motor's current. 

4. The motor controller wherein said motor is a variable reluctance motor and wherein said dynamic operating char- 
acteristic is temperature and wherein said sensor means includes a temperature sensor that provides a signal hav- 

20 ing a value indicative of the temperature of the motor. 

5. The motor controller wherein said motor is a variable reluctance motor and wherein said dynamic operating char- 
acteristic is flux and wherein said sensor means includes a flux sensor that provides a signal having a value indic- 
ative of the flux of the motor. 

6. The motor controller wherein said motor is a variable reluctance motor having a stator and a rotor and wherein 
25 said sensor means includes a rotor position sensor that provides a signal having a value indicative of the position 

of the motor's rotor relative to its stator, a current sensor that provides a signal having a value indicative of the 
motor's current, and a temperature sensor that provides a signal having a value indicative of the temperature of the 
motor. 

7. The motor controller wherein said gain regulator is a controller for processing said current command signal in 
30 accordance with at least one of proportional function, an integral function, and a derivative function. 

8. The motor controller wherein said gain regulator is a controller for processing said current command signal in 
accordance with a proportional function, and an integral function. 

9. The motor controller further including a DC gain compensation circuit for adjusting the value of said current com- 
mand signal to correct for any steady state error values that may be present in the system. 

35 1 0. The motor controller further including at least one notch filter for blocking a predetermined band of frequencies 
from passing to said drive circuit. 

1 1 . The motor controller wherein said at least one notch filter includes circuitry for blocking said band of frequencies 
having a value functionally related to a resonant frequency of said motor. 

12. An electric assist steering system comprising: 

40 

a torque sensor for sensing applied steering torque and providing a signal having a value indicative of the 
applied steering torque; 

an electric assist motor driving connected to a steering member so that when said electric assist motor is ener- 
45 gized, it provides steering assist; 

a motor controller for providing a current command signal having a value functionally related to the sensed 
applied steering torque; 

so sensor means for sensing at least one dynamic operating characteristic of said motor and for providing a signal 

indicative of the at least one sensed dynamic motor operating characteristic; 

variable gain regulator for receiving said current command request signal having a value and for providing a 
motor current control signal having a value functionally related to the value of said received current command 
55 request signal and a gain control value; 

gain scheduler operatively coupled to said variable gain regulator and to said sensing means for providing said 
gain control value to said variable gain regulator in response to said sensed at least one dynamic motor oper- 
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ating characteristic to thereby control the amount of gain of said variable gain regulator; and 

drive circuit operatively connected to the variable gain regulator and said motor for energizing said motor in 
response to said motor current control signal. 

13. The electric assist steering system wherein said electric assist motor is a variable reluctance motor having a 
stator and a rotor and wherein said at least one dynamic operating characteristic is position and wherein said sen- 
sor means includes a rotor position sensor that provides a signal having a value indicative of the position of the 
motor's rotor relative to its stator. 

14. The electric assist steering system wherein said electric assist motor is a variable reluctance motor and 
wherein said at least one dynamic operating characteristic is current and wherein said sensor means includes a 
motor current sensor that provides a signal having a value indicative of the motor's current. 

15. The electric assist steering system wherein said electric assist motor is a variable reluctance motor and 
wherein said at least one dynamic operating characteristic is temperature and wherein said sensor means includes 
a temperature sensor that provides a signal having a value indicative of the temperature of the motor. 

16. The electric assist steering system wherein said electric assist motor is a variable reluctance motor and 
wherein said at least one dynamic operating characteristic is flux and wherein said sensor means includes a flux 
sensor that provides a signal having a value indicative of the flux of the motor. 

17. The electric assist steering system wherein said electric assist motor is a variable reluctance motor having a 
stator and a rotor and wherein said sensor means includes a rotor position sensor that provides a signal having a 
value indicative of the position of the motor's rotor relative to its stator, a current sensor that provides a signal hay- 
ing a value indicative of the motor's current, and a temperature sensor that provides a signal having a value indic- 
ative of the temperature of the motor. 

1 8. The electric assist system wherein said gain regulator is a controller for processing said current command sig- 
nal in accordance with at least one of proportional function, an integral function, and a derivative function. 

19. The electric assist steering system wherein said gain regulator is a controller for processing said current com- 
mand signal in accordance with a proportional function and an integral function. 

20. The electric assist steering system further including a DC gain compensation circuit for adjusting the value of 
said current command signal to correct for any steady state error values that may be present in the system. 

21. The electric assist steering system further including at least one notch filter for blocking a predetermined band 
of frequencies from passing to said drive circuit. 

22. The electric assist steering system wherein said at least one notch filter includes circuitry for blocking said band 
of frequencies having a value functionally related to a resonant frequency of said electric assist motor. 

23. A method for controlling the operation of an electric motor, said method comprising the steps of: 

sensing at least one dynamic operating characteristic of the motor and providing a signal indicative of the at 
least one sensed dynamic motor operating characteristic; 

providing a variable gain regulator for receiving a current command request signal having a value and for pro- 
viding a motor current control signal having a value functionally related to the value of said received current 
command request signal and a gain control value; 

providing the gain control value to the variable gain regulator in response to the sensed at least one dynamic 
motor operating characteristic to thereby control the amount of gain of the variable gain regulator; and 
energizing said motor in response to the motor current control signal. 

24. The method wherein said motor is a variable reluctance motor having a stator and a rotor and wherein said at 
least one dynamic operating characteristic is position and wherein said step of sensing includes the step of sensing 
rotor position and providing a signal having a value indicative of the position of the motor's rotor relative to its stator. 

25. The method wherein said motor is a variable reluctance motor and wherein said at least one dynamic operating 
characteristic is current and wherein said step of sensing includes the step of sensing motor current and providing 
a signal having a value indicative of the motor's current 

26. The method wherein said motor is a variable reluctance motor and wherein said at least one dynamic operating 
characteristic is temperature and wherein said step of sensing includes the step of sensing motor temperature and 
providing a signal having a value indicative of the temperature of the motor. 

27. The method wherein said motor is a variable reluctance motor and wherein said at least one dynamic operating 
characteristic is flux and wherein said step of sensing includes the step of sensing motor flux and providing a signal 
having a value indicative of the flux of the motor. 

28. The method wherein said motor is a variable reluctance motor having a stator and a rotor and wherein said step 
of sensing includes the step of sensing rotor position and providing a signal having a value indicative of the position 
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of the motor's rotor relative to its stator, sensing motor current and providing a signal having a value indicative of 
the motor's current, and sensing motor temperature and providing a signal having a value indicative of the temper- 
ature of the motor. 

29. The method wherein said gain regulator processes said current command signal in accordance with at least 
one of proportional function, an integral function, and a derivative function. 

30. The method wherein said gain regulator processes said current command signal in accordance with a propor- 
tional function and an integral function. 

31 . The method further including the step of adjusting the value of said current command signal to correct for any 
steady state error values that may be present in the system. 

32. The method further including the step of filtering said current command signal to block a predetermined band 
of frequencies from driving the motor. 

33. The method of claim 32 wherein said step of filtering includes blocking said band of frequencies having a value 
functionally related to a resonant frequency of the motor. 

iasmC Jcngth58 M ); /* Adjust assembly language listing */ 
: asm (" -width 120"); /* (filename: XST). */ 
#defineNUM 10000 

#define COMM0 0x30000 /* Start of .bss memory area */ 

*/ ~ 

/* ' 

/* 

/* 
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*/ 

/***********************^ 
*' 

float loop_over_run =0.0; 
float pos_elecdmc = 0.0; 

float tmpa = 0.0; 
float KI = 0.02; 
float aidin = 0.0; 
float Bulkdata = 0.0; 
float plot_data= 0.0; 
float datajrecord = 0.0; 

long curr_calib = 0; 
long AC_sense_cnt = 0; 
long BD_sense_cnt = 0; 

Global variables . 

volatile long *Phase_A_or_C = Gong *) 0x801000; 
volatile long *Phase_j\C = (long *) 0x801001; 
volatile long *Phase w B_or_JD = Gong *) 0x801002; 
volatile long *Phase JD = Gong *) 0x801003; 

volatile long *int_stat_reg; 
volatile long *B0Ajnt_stat_reg; 
volatile long inOtat; 
extern longCommO; 
volatile long *Rd_data; 
volatile long *Rd_addr; 
volatile long *Vbatt_addr; 
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Registers used in Current Control Processing 
****************************^ 

volatile long *Pos_sense = (long *) 0x800030; 

volatile long *Dual_port = (long *) 0x80000e; 

volatile long *a2d_0; 

volatile long *a2d_l; 

volatile long *a2d_2; 

volatile long *d2aj>; 

volatile long *d2a_l; 

/* volatile long *d2a_2; */ 

volatile long *sample_jnarker_cntl; 

volatile long *pwnumarker_cntl; 

/* #include <c:\Isic30\closed\source\contrl3,h> */ 
#include <c:Msic30\closed\source\cntl_22d.h> 
#include <c:Msic30\closed\source\ccaldmc.h> 



Main function. 

void mainO 
{ 

volatile int i; 

float *BD_notch_states, *BD_notch_mem; 

/* Set pointers to DSP register addresses */ 
pt^2_dsp_regs0; /* establish pointers to the DSP board */ 

a2d_0 = (Iong *) 0x0801008; /* point to the A-D port address 0 */ 
a2d_l = (long *) 0x0801009; /* point to the A-D port address 1 */ 
a2d_2 = (long *) 0x080100a; /* point to the A-D port address 2 */ 
d2a_0 = (Iong *) 0x080 100b; /* point to the D-A port address 0 */ 
d2a_l = (long *) 0x080100c; /* point to the D-A port address 1 */ 

/* d2a_2 = 0ong *)0x080100d; point to the D-A port address 2 */ 
sample_marker_cntl = (long *) 0x0801008; /* point to the sample marker */ 
pwm_marker_cntl = Gong *) 0x0801009; /* point to the pwm marker */ 



25 



#include "math-h" 
#include "dspregs.h" 



/* DSP register variables */ 
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/* Set up pointers to variables dual port memory addresses */ 
Rd_data = Gong *) (((long) &CommO) + 0x0); 
Rd_addr = 0ong *) ((flong) &CommO) + 0x1); 
Vbatt^addr = (long *) (((long) &CommO) + 0x10); 
Ac_cmd_addr = (long *) ((Oong) &Comm0) + 0x1 1); 
BdLcmd_addr = (long *) (((long) &Comm0) + 0x12); 

/* Initialize DSP register values */ 

init_dsp_regs(); /* initialize registers on the DSP board */ 

*sample_marker_cntl = OxAAOOOO; f* initialize the sample marker 42.5us=AAOO0O, 
40us=AOOOOO */ 

*pwm_marker_cntl = 0x10000000; f* 10000000 initialize the pwm marker */ 

/* Initialize variables in dual port memory */ 
*Rd_addr= (long) Rd_data; 
*Rd_data = 0; 

/* Enable Interrupts */ 

asmfOR lh, IE ; Enable INT1"); 

asm( M OR 2000h, ST ; Enable global CPU interrupt"); 

BD_notch_mem = (float *)malloc(10*sizeof(float)); 

BD_notch_states = BD_notch_mem; 

/* Continuously write out to a register */ 

while(l) I* Loop here forever (wait for interrupts), */ 

{ 

while(interrupfc==l ) 
{ 

interrupt = 0; 

dmc_control_loop(BD_noteh_states); 
y*************** ******************/ 

/* Data Acquisition Section */ 
/*********************************/ 

if (interrupt =1) Ioop_over_run += -1.0; 
} 

} 

} /*EndofmainQ. •/ 

This section contains the ISR which handle the Digital Current 

Control. 
************************^^ 

/* 

* The next three assembly language instructions tell the linker to 
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* place the address of the interrupt service routine in the vector 

* table : 
*/ 

asm(" -sect Y\int01V m ); 

asm(" -word _c_int01 "); /* Inserts vector to interrupt routine. */ 
asm(" .text "); /* Put rest of code in ".text" section, */ 

/* Interrupt Service Routine */ 
voidc_int01(void) 

{ 

interrupt^ 1; 

} 

void dmc_controLJoop(notch_states) 
float *notch_states; 

{ float Batt_volt_inv = 0.0; I* 20000.0/12.5; */ 
float ACLcmd = 0.0; 
float AC_phs_select = 0.0; 
float BD_cmd = 0.0; 
float BD_j>hs_select = 0.0; 
float ACLsense = 0.0; 
float BD_sense = 0.0; 
float AC_pos_mech = 0.0; 
float BD_pos_mech = 0.0; 

float GainJ) = 0.0; 
float flt_notch_*n=0.0; 
float extjnput = o.O; 
float errj = 0.0; 
float tmpb =0.0; 

register float feedback; V* sensed feedback current */ 

register float input; /* commanded current */ 

register short high_fet_cmd; I* PWM command to high FET */ 

register short low_fetL_cmd; /* PWM command to low FET */ 

register float pcCpwnucmd; /* percent PWM command (0.0 to 1 .0) */ 

register long position; /* sensed motor position */ 

register int phase_sel_AC; I* select channel A or C */ 

register int phase_seIJBD; /* select channel B or D */ 



/* if Int_count== 0 or 1 */ 
if (Int_count < 2) 

{ 

if (lnt_count==0) 
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{ /* if dual port is cleared*/ 
if(!(*DuaI_port)) 
{ 

/* This is where to write AC Sense 

The read of position can be removed */ 
position as *Pos_sense; I* read motor position */ 
♦Dual _port = position; /* send motor position to dual port */ 
Int_count++; /* increment Int_count */ 

} 

} 

/* else (Int_count == 1) */ 
else 
{ 

/* if bit 30 in dual port is set */ 
if (*Dual_port & 0x40000000) 

/* This is where to write BD Sense */ 
/* *Dual_port = position; send motor position to dual port */ 
if (curr_calib>0) 

{ *Dual - port=(BD_sense_cnt)«16; 
}else 

{ *Dualj)ort = 0ong)(BD_sense*100)«16; 

/* *DuaLport = Gong)(tmpa* 10000)«16; */ 
Input_AC = *Dual_port; I* get AC command from dual port */ 
Int_count++; f* increment Int_count */ 

} 

/* else, communication is out of sync so reset Int_count */ 
else Iht_count = 0; 

} 

} 

Z*ifInt_countis2or3*/ 
else if (Int_count<4) 
{ 

/*ifIhL.count = 2*/ 
if (Int_count — 2) 

/* if bit 30 in dual port is cleared */ 
if (!(*Dual_port & 0x40000000)) 

1 /* Position will be written now, 2/5/98 */ 

t* position = *Pos_sense; */ /* read motor position */ 
/* *DuaIj>ort = position; send motor position to dual port */ 
if (curr_calib>0) 

{ *Dual_port = (AC_sense_cnt)«16; 
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Jelse 

{ *DuaIjport = 0ong)(AC_sense*100.0)«16; 
/**DuaI.port = (Iong)(tmpa*100.0)«16; */ 

} 

InputJBD = *DuaI_port; /* get BD command from dual port */ 
Int_count4-K /* increment InUcount*/ 

/* else, communication is out of sync so reset Int_count */ 
else lht_count = 0; 

} 

/* else (Iht_count = 3) */ 

else 

{ 

/* if bit 29 in dual port is set */ 
if (*Dualj)ort & 0x20000000) 

{ 

/* This is a dummy write position */ 
*Dual_port = position; /* send motor position to dual port */ 

/* read battery voltage from dual port */ 
Batt_voIt_jnv = (*Dual_port & 0x01ff0000) » 16; 
pos_elecdmc = Batt_volt_Jnv; 
curr_calib = (*Dual_port & 0x10000000) » 16; 
Int_count++; /* increment Int_count */ 

/* else, communication is out of sync so reset Int_count */ 
else Int_count = 0; 

} 

} 

/* else, if last interrupt in cycle */ 
/♦else if (Int_count>= 10) */ 
else if (Int_count >= 7) 

^ Int^count = 0; /* reset Int_count (Le. start new cycle) */ 
} 

/* else, just increment Int_count */ 
else Int_count++; 

/* get phase select bit for phase A or C */ 
phase_sel_AC = (Input_AC & 0x80000000) » 16; 

/* get A/C current command and scale to Amps */ 
input = ((Input_AC « 3) » 16) * Cmd_scale; /* Units of Amps */ 

/* exUnput = «(*a2dU2 » 20) & Ox00007fS) )*0.05; 200/4096 Units of Amps 

./ 

AC_cmd = input; 

/* input = ACLcmd; */ 

/* read A/C feedback and scale to Amps and calibrate */ 
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AC_sense_cnt = ((*a2d_0 » 17) & 0x00007fff); 

/* tmpa = (float)AC_sense_cnt;*/ 
if(phase_seLAC >= 1) 
/* — Phase A*/ 

^ feedback = AC_sense_cnt * L_scale_A + X_off_A; I* Units of Amps */ 
} 

else 

^ feedback = AC_sense_cnt * I_scaIe_C + I_off_C; I* Units of Amps */ 
} 

ACLsense = feedback; 
/* Current at position 0 */ 

if (AC_sense < 8) 

Gain_0 = 0.3519; I* 0.2889; 3704; 0.4; higain; */ 

} 

else if (AC_sense < 36) 

j* Gain_0 = 0.3704 - 0.01704 * AC_sense + 0.1704 ; */ 
/* Gain_0 = 0^889 - 0.00873 * ACLsense + 0.0698 ; */ 
Gain_0 = 0.3519 - 0.01098 * ACLsense + 0.0878 ; 
} 

else 

Gain_0 = 0.04444 ; I* lowgain; */ 
} 

tmpa = GainjO; 
if (phase_sel_AC >= 1) 
if (pos_elecdmc > 270) 

AC_pos_mech = 0.16666 * ( 450 - pos_eIecdmc ) ; 
else if (pos_elecdmc > 90) I* - 90 < position < 270 — */ 

^ AC_pos_mech = 0.16666*(pos_elecdmc - 90); 
eke /* — 0 < position < 90 — - */ 

AC_pos_mech = 0.16666*( 90 - pos_eIecdmc ); 

} 

else 

/* — Phase C */ 
{ 

if (pos_elecdmc > 270) 
{ 
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AC_pos_mech = 0.16666 * ( pos_eIecdmc - 270) ; 

} 

else if (pos_eIecdmc> 90) /* — 90 < position < 270 — */ 
AC_pos_mech = 0.16666*( 270 - pos_e!ecdmc); 

} 

else I* — 0 < position < 90 — */ 
{ 

AC_pos_mech = 0.16666*( 90 + pos_elecdmc ); 

} 

/* CALCULATE THE CORRECTION FACTOR OF POSITION WRT ALIGN 

POSITION */ 
if (AC_pos_mech > 24) 

{ 

Gain_0 = 0.04444; t* lowgain; */ 

} 

else if (AC_pos_mech > 5) 

Gain 0 = Gain_0 - 0.05263 * (Gain_0 - 0.04444) * (AC_pos_mech - 5); 
} 

I* 

FORWARD PATH NOTCH 
*/ 

err_J = input - feedback; 
if (AC_cmd<= 1-5) 

{ noteh_states[8] = 0; } 
else if ( fabs(noteh_states[2] < 0.94 ) ) 

{ noteh_states[8] = noteh_states[8] + errj[; } 

fit_noteh_jcn = Gain_0 * (err_I + K3*notch_states[8]); /* ki_i = 2000/20/13.5 */ 

/* flt_notch_^n = Gain_0 * (input - feedback); */ 

/* . 

This routine implements a complex pole/zero notch filter 
■ */ 

pct_pwm_cmd = 1 .302 * notch_states[2] - 0.5245*notch_states[3] 
+ 0.8019*flUiotch_xn - 1.302*notch_states[0] + 0.7226*notch_states[l]; 

notch_states[3] = notch_states[2]; 
notch_states[2] = pct_pwm_cmd; 
notch_states[l] = noteh_states[0]; 
notch_states[0] = flt_notch_xn; 

J* Use FWM command offset to adjust for hardware 
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pcL.pwm_cmd -= 0.06; */ 

/* Limit pct_pwm_cmd to +/- foil scale (+/- 1,0) */ 
if (pct_pwm_cmd > .95) 

pct_pwm_cmd = .95; 
if (pct_j>wm_cmd < -.95) 

pct_pwm_cmd = -.95; 

/* calculate the output values going to the motor */ 
/* round PWM command to high FET */ 

high_fet_cmd = 

((short)(Pwm_scale * pct_pwm.cmd + 330.5)); /*340.5)); */ 
/* trancate PWM command to low EET */ 
low_fet_cmd = 

(short)(Pwm_scale * (Pwm_offset - pctjpwnucmd)); 

/* write PWM command to phase A or C */ 
*Phase_A_or_.C = 0ow_fet_cmd I phase_sel_AC) « 16; 

/* write PWM command to phase A/C */ 
*Phase_AC = (high_fet_cmd 1 0x8000) « 16; 

/♦=== 
Phase BD control 

*' 

/* get phase select bit for phase B or D */ 
phase_seIJBD = (InputJBD & 0x80000000) » 16; 

/* get B/D current command and scale to Amps */ 

input = ((InputJBD « 3) » 1 6) * Cmd_scale; 
BD_cmd = input; 

/* read B/D feedback and calibrate to Amps */ 

BD_sense_cnt = ((*a2d_l » 17) &0x00007f£f); 
if(phase_selJBD >= I) 

feedback = BD_sense_cnt * I^scale^ + 1-OfLP; f* Units of Amps */ 

} 

else 

feedback = BD_sense_cnt * LscaleJD + LofiLD; /* Units of Amps */ 

} 

BD_sense = feedback; 
if (BD_sense<8) 
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{ 

Gain_0 = 0.2889; /*3704; 0.4; higain; */ 

} 

else if (BD_sense < 36) 
( 

/* Gain_0 = 0.3704 - 0.01704 * AC_sense + 0.1704 ; 

Gain J) = 0.2889 - 0.00873 * BD_sense + 0.0698 ; */ 
Gain_0 = 0.3519 - 0.01098 * BD_sense + 0.0878 ; 
} 

else 
{ 

Gain_0 = 0.04444 ; I* lowgain; */ 
} 

if (phase_selJSD >= 1) I* — Phase B */" 

if (pos_elecdmc < 1 80) 
{ 

BD_pos_mech = 0.16666 * ( 180 - pos_elecdmc ); 

} 

else /* Phase B> 180*/ 
{ 

BD_pos_mech - 0.16666 * ( pos_elecdmc - 180 ); 

} 

else 

I* — PhaseD*/ 
if (pos_elecdmc < 180) 
{ 

BD_pos_mech = 0.16666 * pos_elecdmc; 

} 

else /* Phase D> 180*/ 
{ 

BD_pos_jnech = 0.16666 * ( 360 - pos_elecdmc); 

> 

/* CALCULATE THE CORRECTION FACTOR OF POSITION WRT ALIGN 

POSITION */ 
if (BD_pos_mech > 24) 

{ • 
GainJ) = 0.04444; /* lowgain;*/ 

} 

else if (BD_pos_piech > 5) 

Gain_0 = Gain_0 - 0.05263 * (Gain_0 - 0.04444) * (BD_pos_mech - 5); 
} 

I* 
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FORWARD PATH NOTCH 
*/ 

err_J = input - feedback; 

if (BD_cmd <= 1.5) 

{ notch_states[9] = 0; } 

else if ( fabs( notch_states[6] < 0.94 ) ) 

{ noteh_states[9] = noteh_states[9] + errj;; } 



flt_notch_xn = Gained * (errj[ + KI*notch_states[9] ); 

/* flt_notch_xn = Gain J) * (input - feedback); .*/ 

/* 

This routine implements a complex pole/zero notch filter 
_ */ 

pct_pwm_cmd = 1.302 * notch_states[6] - 0.5245*notch_states[7] 

+ 0.801 9*fIt_notch_xn - L302*notch_states[4] +0.7226*notch_states[5]; 

notch_states[7] = notch_states[6]; 

notch_states[6] = pct_pwm_cmd; 

notch_states[5] = notch_states[4]; 

notches tates [4] = flt_notch_*n; 

/* Use PWM command offset to adjust for hardware 
pct^pwm^cmd -= 0.06; */ 

/* Limit pct_pwrrucmd to +/- full scale (+/- 1.0) */ 
if (pct_pwm_cmd > .95) 

pcLj>wm_cmd = .95; 
if (pct_pwm_cmd < -.95) 

pct_pwm_cmd = -.95; 

/* *d2a_0 = (Gong) ((pct_pwm_cmd+l) * 1000)) « 20; */ 
/* *d2a_0 = (phase_seIJ3D) « 12; */ 
*d2a_0 = (Gong) (BD_sense * 20.48)) « 20; 
*d2a_l = (Gong) (BD_cmd * 20.48)) « 20; 

/* *d2a_l = (Gong) (Gain_0*2000)) « 20; */ 

/* calculate the output values going to the motor */ 
f* round PWM command to high FET */ 
high_fet_cmd = 

((short)(Pwm_scale * pcLpwm_cmd + 330^)); /* 340.5)); */ 
/* truncate PWM command to low FET */ 
low_fet_cmd = 

(short)(Pwnuscale * (Pwmi_offset - pcLpwirucmd)); 
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/* write PWM command to channel B or D */ 
*Phase_£_orJD = (low_fet_cmd 1 phase_seL3D) « 16; 

/* write PWM command to channel B/D */ 
*Phase_3D = (high_fet_cmd 1 0x8000) « 16; 

/* clear C30 f s INT1 (end of convert) */ 
asm(" AND OFFFEh, IF 1 ); 

} 

^♦******************************************^ 
♦♦************************************************^ 

void pt_2_dsp_regs(void) 

{ ' • 

/* external interface control register */ 

expctl = Oong *) 0x00808060; /* expansion bus control reg */ 

primctl = Oong *) 0x00808064; /* primary bus control reg */ 

int_stat jeg = Cong *) 0x00800007; 
BOA_int_stat_reg = Oong *) 0x00800003; 

B0RA_ChO_data =0ong *) 0x00800000; 
B0RA_Reset =0ong *) 0x00800001; 
B0RA_Ch2_data = 0ong *) 0x00800002; 
BORAJritStat =0ong *) 0x00800003; 
B0RA_Chl_data =0ong *) 0x00800004; 
BORA^AmeliaStat = (long *) 0x00800005; 
B0RA_Ch3_data =0ong *) 0x00800006; 



B0WA_Ch0_data 

B0WA_Timerl 

B0WA_Ch2_data 

B0WA_IntMask 

B0WA_Chl_data 

BOWA^AmeliaCU 

B0WA_Ch3_data 

BOWA_JtteUsrCfg 



= (long *) 0x00800000; 
= Oong *) 0x00800001; 

= 0ong *) 0x00800002; 
= 0ong *) 0x00800003; 

= (long *) 0x00800004; 

= (]ong *) 0x00800005; 

= (long *) 0x00800006; 

= Oong *) 0x00800007; 



B0RB_ChO_data =0ong *) 0x00800008; 
B0RB_Reset = Oong *) 0x00800009; 
B0RB_Ch2_data = Oong *) 0x0080000A; 
BORBJntStat = 0ong *) Ox0080000B; 
B0RB_Chl_data =0ong *) Ox0080000C; 
B0RB_>meliaStat = Oong *) Ox0080000D; 
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B0RB_Ch3_data =(Iong *) Ox0080000E; 



BOWB_ChO_data 
BOWB_Timerl 
B0WB_Ch2_data 
BOWB_IntMask 
BOWB_Chl_data 
BOWB_AmeIiaCtI 
B0WB_Ch3_data 
BOWBJRteUsrCfg 

BlRA^ChO.data 
BlRA_Reset = 
. BlRA w Ch2_data 
BlRAJhtStat = 
BlRA_Chl_data 
BlRA_ArneliaStat 
BlRA_Ch3_data 
BlWA_ChO_data 
BlWAJTimerl 
BlWA_Ch2_data 
BIWAJntMask 
BlWA_Chl_data 
BlWA_AmeliaCtl 
BlWA_Ch3_data 
BlWAJRteUsrCfg 
BlRB_ChO_data 
BlRB_Reset = 
BlRB_Ch2_data 
BIRBJtotStat = 
BlRB_Chl_data 
B lRB_AmeIiaStat 
BlRB_Ch3_data 
BlWB_ChO_data 
BlWBJTimerl 
BlWB_Ch2_data 
BIWBJhtMask 
BlWB_Chl_data 
B1WB _AmeliaCtI 
BlWB_Ch3_data 
BlWB_RteUsrCfg 



= 0ong *) 0x00800008; 
= flong *) 0x00800009; 
= (long *) Ox0080000A; 
= 0ong *) Ox0080000B; 
= (long *) Ox0080000C; 
= Gong *) Ox0080000D; 
= (Iong *) Ox0O8000OE; 
= 0ong *) OxO080O00F; 

= 0ong *) 0x00800010; 
= (long *) 0X00800011; 

= (long *) 0x00800012; 
= 0ong *) 0x00800013; 
= Gong *) 0x00800014; 
- (long *) 0x00800015; 
= (long *) 0x00800016; 
= (long *) 0x00800010; 
= Gong *) 0x00800011; 
= (long *) 0x00800012; 
= Gong *) 0x00800013; 
= (long *) 0x00800014; 
= (long *) 0x00800015; 
= Gong *) 0x00800016; 
= Gong *) 0x00800017; 
= Gong *) 0x00800018; 
Gong *) 0x00800019; 
= Gong *)Ox008O001A; 
Gong *) 0X008OO01B; 
= Gong *) Ox0080001C; 
= Gong *) 0x0080001D; 
= Gong *) Ox0080001E; 
= Gong *) 0x00800018; 
= Gong *) 0x00800019; 
= (long *) 0x0080001A; 
= Gong *) 0x008000IB; 
= Gong *) 0X0080001C; . 
= (long *) 0x0080001D; 
= Gong *) 0X0080001E; 
= Gong *)0x0080001F; 



} 



void init__dsp_regs0 
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{ 

short j; 

/* EXPANSION BUS RELATED */ 
/* Set up Primary Bus Control Register */ 
/* Fields of primctrl register 

HOLDST-0 flag identifying whether port is being held 
NOHOLD-0 disallow port to be held by an external HOLD signal 
HE-O internal hold of port by software 
SWW-0 software wait mode 

WTCNT-4 software wait mode - # of cycles to use when in sw wait mode 
BNKCMP-0 bank compare - # of MSBs of addr to be use to define bank size 
Reserved-0 reserved bits 
*/ 

♦primed = 0x00000080; 

/* Set up Expansion Bus Control Register */ 
f* Fields of expctrl register 
Reserved-0 reserved bits 
SWW-0 move of SW wait-state generation 

WTCNT-0 software wait mode - # of cycles to use when in sw wait mode 

Reserved-0 reserved bits 

*/ 

*expctl =0x00000000; 
/"■-Step 1 - Reset DM -*/ 

j _ *B0RA_Reset; /* Dummy Read to reset carrier */ 

/* — > (First write after reset is route config)< ■ */ 

*B0WA_RteUsrCfg = OxOOOEOOOO; 7* Set up Route Register */ 

/*— > Step 3 - Configure Timer 1 Register IF REQUIRED < */ 

*B0WA_Timerl=0xFE170000; I* */ 

/*— > Step 4 - Configure Interrupt Mask Register for MASTER DM < */ 

*B0WA_IntMask = 0x00010000; /* Set up Interrup Mask for NO INTR */ 

/*— > Step 5 - Configure AMELIA Control Register for Master DM < */ 

*B0WA_AmeliaCtl = OxOOB20000; /* Amelia Ctl Register */ 

/*—> Step 6 - Configure User Control Register for Master DM < */ 

*B0WAJRteUsrCfg = OxA4000000; I* *' 

I* — ^> Step 7 - Repeat Step 1.. 3,5,6 for each slave DM <- ■ */ 

/* Board 0 Ch.B — Steps: 1,2^^,6 */ 

j _ *B0RB_Reset; /* Step 1 : Dummy Read to reset */ 

*B0WB _RteUsrCfg = OxOOCOOOOO; t* Step 2: Set up Route Register */ 

I* Step 3: Set up Timer register NOT REQ. */ 

t* Step 4: interrupt Register NOT REQ. */ 
*B0WB_AmeliaCtl = 0x00320000; /* Step 5: Amelia Ctl Register */ 
*B0WB JtteUsrCfg = OxAOOOOOOO; I* Step 6: Config User Control Register */ 
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I* Board 1 Ch. A — Steps: 1 ,2,3,5,6 */ 

j = *B IRA-Reset; /* Step 1 : Dummy Read to reset */ 

*B lWA_RteUsrCfg = OxOOCOOOOO; /* Step 2: Set up Route Register */ 
/* Step 3: Set up Timer register NOT REQ. */ 

/* *BOWA_JntMask = 0x00000000; */ /* Step 4: interrupt Register NOT REQ. */ 

*B 1 WA_AmeIiaCtI = 0x00320000; /* Step 5: Amelia Ctl Register */ 
*B 1 WAJRteUsrCfg = OxAOOOOOOO; /* Step 6: Config User Control Register */ 

/* Board 1 Ch3 — Steps: 1,234.6 */ 

j = *B lRB_Reset; /* Step 1: Dummy Read to reset */ 

*B 1 WB_RteUsrCfg = OxOOCOOOOO; t* Step 2: Set up Route Register */ 

/* Step 3: Set up Timer register NOT REQ. */ 

/* Step 4: interrupt Register NOT REQ. */ 
*B lWB^AmeliaCtl = 0x00320000; I* Step 5: Amelia Ctl Register */ 
*B 1 WB_RteUsrCfg = OxAOOOOOOO; I* Step 6: Config User Control Register */ 

/*— > Step 8 - Write Config Register KEY for each DM < -*/ 

♦BOWAJRteUsrCfg = 0x8DFF0000; /* Set up config register for BO DM_A */ 
*BOWB_RteUsrCfg=0x8DFFO000; /* Set up config register for BO DMJB */ 



*BlWA_RteUsrCfg = 0x8DEF0000; 
♦BlWB^RteUsrCfg = 0x8DFF0000; 

} 



/* Set up config register for B 1 DM^A. */ 
/* Set up config register for B 1 DMJB */ 



/*— : 

Current Calibration Data. - 
*/ 

#define L_scale_A 0.003037 
#define I_scaIe_B 0.002994 
#define Uscale_C 0.003038 
#define I_scaleJD 0.002999 
tfdefine Jjd&_A 0.056536 
^define LoffJB -0.404484 
#define XjoffjC 0.095642 
#define Loff JD -0.425 1 17 
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Global variables used in Current Control Processing 
♦*************************^^ 

/* float Batt_volt_inv = 20000.0/1 2.5; (1/VBatt) * 20000 */ 
long Input^C = 0; 
long InputJSD = 0; 
short Int_count = 0; 

^******************^^ 

Global Constants for Digital Current Control Processing 
***********************^^ 

/* 

* Gain = 13.4 * ((1 full scale PWM) / (100 Amps)) * (A2D scale) 

* 1 3.4 = the analog gain for the 94 system 

* 0.8 1 = compensation for A2D scaling error 
*/ 

#defme gainscale 0.0037 /* 0.004 0.0037 = 1/13.5/20 for controller in ohms 

0.004=1/12.5/20 */ 
/* #define Gain 0.08 1/12.5 assumed nominal voltage of one */ 
/* #define lowgain 0.048 1 0.032 8 * gainscale */ 
/* #define higain 0.37 0.4 100 * gainscale */ 
/* #define gslopel 0.01609 0.0184 4.6 * gainscale */ 

#define Pwm^scale 330.0 /* (340 counts) / (full scale PWM) */ 
#definePwm_offset 1.0 /* (full scale PWM) offset */ 

#define Cmd_scale 0.0061035; /*200.0 / 32768.0 */ 



Claims 

Having fully described the invention, the following is claimed: 

1 . A motor controller for controlling the operation of an electric motor, said motor controller comprising: 

sensing means for sensing at least one dynamic operating characteristic of said motor and for providing a sig- 
nal indicative of the at least one sensed dynamic motor operating characteristic; 

variable gain regulator for receiving a current command request signal having a value and for providing a motor 
current control signal having a value functionally related to the value of said received current command request 
signal and a gain control value; 

gain scheduler operatively coupled to said variable gain regulator and to said sensing means for providing said 
gain control value to said variable gain regulator in response to said sensed at least one dynamic motor oper- 
ating characteristic to thereby control the amount of gain of said variable gain regulator; and 
drive circuit operatively connected to the variable gain regulator and said motor for energizing said motor in 
response to said motor current control signal. 

2. The motor controller of any of the preceding claims wherein said motor is a variable reluctance motor having a sta- 
tor and a rotor and wherein said dynamic operating characteristic is position and wherein said sensor means 
includes a rotor position sensor that provides a signal having a value indicative of the position of the motor's rotor 
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relative to its stator, 

and/or wherein preferably said motor is a variable reluctance motor and wherein said dynamic operating 
characteristic is current and wherein said sensor means includes a motor current sensor that provides a cignal hav- 
ing a value indicative of the motor's current, 

and/or wherein preferably said motor is a variable reluctance motor and wherein said dynamic operating 
characteristic is temperature and wherein said sensor means includes a temperature sensor that provid er, a signal 
having a value indicative of the temperature of the motor, 

and/or wherein preferably said motor is a variable reluctance motor and wherein said dynamk: operating 
characteristic is flux and wherein said sensor means includes a flux sensor that provides a signal havl n a value 
indicative of the flux of the motor, 

and/or wherein preferably said motor is a variable reluctance motor having a stator and a rotor ar c: wherein 
said sensor means includes a rotor position sensor that provides a signal having a value indicative of ths position 
of the motor's rotor relative to its stator, a current sensor that provides a signal having a value indicative of the 
motor's current, and a temperature sensor that provides a signal having a value indicative of the temperature of the 
motor. 

The motor controller of any of the preceding claims wherein said gain regulator is a controller for processing said 
current command signal in accordance with at least one of proportional function, an integral function, and a deriv- 
ative function, 

and/or wherein preferably said gain regulator is a controller for processing said current command signal in 
accordance with a proportional function, and an integral function, 

and/or further preferably including a DC gain compensation circuit for adjusting the value of said current 
command signal to correct for any steady state error values that may be present in the system, 

and/or further preferably including at least one notch filter for blocking a predetermined band of frequencies 
from passing to said drive circuit 

and/or wherein preferably said at least one notch filter includes circuitry for blocking said band of frequencies 
having a value functionally related to a resonant frequency of said motor. 

An electric assist steering system comprising: 

a torque sensor for sensing applied steering torque and providing a signal having a value indicative of the 
applied steering torque; 

an electric assist motor driving connected to a steering member so that when said electric assist motor is ener- 
gized, it provides steering assist; 

a motor controller for providing a current command signal having a value functionally related to the sensed 
applied steering torque; 

sensor means for sensing at least one dynamic operating characteristic of said motor and for providing a signal 
indicative of the at least one sensed dynamic motor operating characteristic; 

variable gain regulator for receiving said current command request signal having a value and for providing a 
motor current control signal having a value functionally related to the value of said received current command 
request signal and a gain control value; 

gain scheduler operatively coupled to said variable gain regulator and to said sensing means for providing said 
gain control value to said variable gain regulator in response to said sensed at least one dynamic motor oper- 
ating characteristic to thereby control the amount of gain of said variable gain regulator; and 

drive circuit operatively connected to the variable gain regulator and said motor for energizing said motor in 
response to said motor current control signal. 

The electric assist steering system of any of the preceding claims wherein said electric assist motor is a variable 
reluctance motor having a stator and a rotor and wherein said at least one dynamic operating characteristic is posi- 
tion and wherein said sensor means includes a rotor position sensor that provides a signal having a value indicative 
of the position of the motor's rotor relative to its stator, 

and/or wherein preferably said electric assist motor is a variable reluctance motor and wherein said at least 
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one dynamic operating characteristic is current and wherein said sensor means includes a motor current sensor 
that provides a signal having a value indicative of the motor's current, 

and/or wherein preferably wherein said electric assist motor is a variable reluctance motor and wherein said 
at least one dynamic operating characteristic is temperature and wherein said sensor means includes a tempera- 
ture sensor that provides a signal having a value indicative of the temperature of the motor, 

and/or wherein preferably wherein said electric assist motor is a variable reluctance motor and wherein said 
at least one dynamic operating characteristic is flux and wherein said sensor means includes a flux sensor that pro- 
vides a signal having a value indicative of the flux of the motor. 

The electric assist steering system of any of the preceding claims wherein said electric assist motor is a variable 
reluctance motor having a stator and a rotor and wherein said sensor means includes a rotor position sensor that 
provides a signal having a value indicative of the position of the motor's rotor relative to its stator, a current sensor 
that provides a signal having a value indicative of the motor's current, and a temperature sensor that provides a sig- 
nal having a value indicative of the temperature of the motor, 

and/or wherein preferably said gain regulator is a controller for processing said current command signal in 
accordance with at least one of proportional function, an integral function, and a derivative function, 

and/or wherein preferably said gain regulator is a controller for processing said current command signal in 
accordance with a proportional function and an integral function, 

and/or further preferably including a DC gain compensation circuit for adjusting the value of said current 
command signal to correct for any steady state error values that may be present in the system, 

and/or further preferably including at least one notch filter for blocking a predetermined band of frequencies 
from passing to said drive circuit, 

and/or wherein preferably said at least one notch filter includes circuitry for blocking said band of frequencies 
having a value functionally related to a resonant frequency of said electric assist motor. 

A method for controlling the operation of an electric motor, said method comprising the steps of: 

sensing at least one dynamic operating characteristic of the motor and providing a signal indicative of the at 
least one sensed dynamic motor operating characteristic; 
30 providing a variable gain regulator for receiving a current command request signal having a value and for pro- 

viding a motor current control signal having a value functionally related to the value of said received current 
command request signal and a gain control value; 

providing the gain control value to the variable gain regulator in response to the sensed at least one dynamic 
motor operating characteristic to thereby control the amount of gain of the variable gain regulator; and 
35 energizing said motor in response to the motor current control signal. 

8. The method of any of the preceding claims wherein said motor is a variable reluctance motor having a stator and 
a rotor and wherein said at least one dynamic operating characteristic is position and wherein said step of sensing 
includes the step of sensing rotor position and providing a signal having a value indicative of the position of the 

40 motor's rotor relative to its stator, 

and/or wherein preferably said motor is a variable reluctance motor and wherein said at least one dynamic 
operating characteristic is current and wherein said step of sensing includes the step of sensing motor current and 
providing a signal having a value indicative of the motor's current 

and/or wherein preferably said motor is a variable reluctance motor and wherein said at least one dynamic 

45 operating characteristic is temperature and wherein said step of sensing includes the step of sensing motor tem- 
perature and providing a signal having a value indicative of the temperature of the motor, 

and/or wherein preferably said motor is a variable reluctance motor and wherein said at least one dynamic 
operating characteristic is flux and wherein said step of sensing includes the step of sensing motor flux and provid- 
ing a signal having a value indicative of the flux of the motor, 

so and/or wherein preferably said motor is a variable reluctance motor having a stator and a rotor and wherein 

said step of sensing includes the step of sensing rotor position and providing a signal having a value indicative of 
the position of the motor's rotor relative to its stator, sensing motor current and providing a signal having a value 
indicative of the motor's current, and sensing motor temperature and providing a signal having a value indicative of 
the temperature of the motor. 

55 

9. The method of any of the preceding claims wherein said gain regulator process said current command signal in 
accordance with at least one of proportional function, an integral function, and a derivative function, 

and/or wherein preferably said gain regulator processes said current command signal in accordance with a 
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proportional function and an integral function, 

and/or further preferably including the step of adjusting the value of said current command signal to < orrect 
for any steady state error values that may be present in the system, 

and/or further preferably including the step of filtering said current command signal to block a predetermined 
5 band of frequencies from driving the motor, 

and/or wherein preferably said step of filtering includes blocking said band of frequencies having a value 
functionally related to a resonant frequency of the motor. 

10. A motor controller for controlling the operation of an electric motor, said motor controller comprising: 

10 



sensing means for sensing at least one dynamic operating characteristic of said motor and for providing a sig- 
nal indicative of the at least one sensed dynamic motor operating characteristic; and 
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variable gain regulator for receiving a current command request signal having a value and for providing a motor 
current control signal. 




25 



30 



35 



c 



40 



45 



SO 



55 



35 



BNSDOCID: <EP 0943528A2_I_> 



EP 0 943 528 A2 




CO. 



■«l8 




o 
eg 



+ 

CD 



Li. 




36 



BNSDOCID: <EP 0943528A2_L> 



EP 0 943 528 A2 













<cr 

Q- UJ 


IGH- 


— i 








LL 



37 



<EP. 



.0943528A2_L> 




BNSDOCJD: <EP 0943528A2J_> 



39 



EP 0 943 528 A2 





40 



BNSDOCID: <EP 0943528A2_I_> 



EP 0 943 528 A2 



1 000y- 




.Oly-H 1 1 — 1 Mz 

10x 100x 1000x 3200x 

Fig.12 



41 



BNSDOCID: <EP 0943S2BA2J_> 




BNSDOCID: <EP 094352BA2J_> 



EP 0 943 528 A2 




DKiennrtin. -co 



